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METHOD OF AND APPARATUS FOR CORRECTION OF COORDINATE ^ 
RCEASUREMENT E RRORS DUE T Oj gRRATTONS IN COORDINATE 
MEASURING MACHINES ( CMMS). 

The present invention relates to the correction of coordinate measuring errors in 
CMMs due to vibrations of the component parts thereof. 

United States patent specification numbers 5,594,668 & 5,610,846, both assigned to 
1 0 Carl-Zeiss of Gennany describe methods that use machine acceleration information 
with the aid of correction tables to determine the amount of displacement of the probe 
head due mainly to probing force. 

In accordance with the description in these patents, the acceleration information in the 
15 three translation directions is obtained by double differentiating scale information. 
This gives the acceleration of the CMM at the measurement scales and not at the 
probe head. 

Also in the methods described in the above-mentioned patents, a correction table 
2 0 containing prior knowledge of the bending behaviour of a particular CMM due to 

various accelerations and velocities at various positions is used to provide a correction 
to measurements obtained from the scales. 

Another United States patent, document number 5,579,246 assigned to Carl-Zeiss of 

2 5 Germany describes a method that has a similar goal, that is improving measurement 

accuracy with the aid of accelerometers located near or in the probe head. However 
the technique described requires a mathematical model describing the dynamic 
behaviour of the CMM within its measurement voliraie. Information gattiered from 
the accelerometers are used as input to the model, the model then produces an 

3 0 estimate of the structural vibration, and thus the displacement of the probe head from 

its nominal axis. 
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^jS^^]^™'^™*' Descriptio^of the Invention 



TJieoretical Backsi'ound 

The dynamic response of the probe head mounted on a CMM with a flexible structure 
5 will exhibit a typical behaviour frequency response as shown in Figure la, this is an 
ideal frequency response of displac^ient between the probe head and the 
measurement scales. The values and shape of this frequency response is imique to a 
particular axis of a particular CMM, Frequency response identification is normally 
carried out as part of a CMM installation procedure to aid in "tuning" the servo 

1 0 system, and there are many common and well established methods for performing 
frequency response identification. The frequency response of the probe head in a 
particular axis can be obtained by performing a frequency response identification 
between the probe head velocity (measured using accelerometers) and velocity 
obtained from the measurement scale for that axis, this will show the frequency region 

1 5 where the probe head is rigidly coupled to the scale. 



P 



S] Correcting Translational Measurement Errors 

Figure lb shows ^ exa^p leVith a probe head mounted on a CMM with a vertical 
column. It is assumed that acceleration forces in the 3 orthogonal axes will cause the 
2 0 probe head to displace from it nominal centre. Accelerometers positioned in this axis 
system will detect probe head motion in the x, y & z axis accordingly. In the context 
of this example, an acceleration force vector with x, y and z axis components acting 
on the probe head will cause the CMM's flexible structure to distort. The acceleration 
forces (Ax, Ay, Az) acting on the probe head will cause a displacement (Dx, Dy,Dz) 

2 5 from its nonninal centre, this displacement is described as a displacement vector, Dph. 
The instantaneous value of the displacement vector (Dph) is deduced from 
accelerometers configured to sense motion in the three orthogonal axes, and for the 
purpose of this illustration, the accelerometers are placed at the centre of the probe 
head. The positional relationship between the probe tip and the centre of the probe 

3 0 head remains the same. 
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The displacement vector (Dph) is then used in association with linear scale 
information to estimate the position of the probe head in the presence of dynamic 
forces distorting the structure of the CMM. 

5 Correcting Translational and Rotational Errors 

Angular displacement about the 3 orthogonal axes is sensed using angular acceleration 
sensors. As shown in Figure Ic, a rotational distortion at the probe head will misalign 
the axis system of the 3 orthogonal accelerometers with that of the CMM's axis 
system. The accelerometCTS are now measuring acceleration components Aph__x, 

1 0 Aph_y and Aph_z instead of Ax, Ay and Az, Angular acceleration about the 3 
orthogonal axes (Rx, Ry, Rz) is sensed using either gyroscopes or angular 
accelerometers, this information is than used to calculate a direction matrix (C). The 
dnection matrix describes the orientation of the linear accelerometers axes (Aph_x, 
Aph_y, Aph_2) to that of the CMM axes (Ax, Ay, Az), in other words, the direction 

15 the linear accelerometers in the probe head are pointing with respect to the CMM 
axes. The direction matrix is used to calculate the acceleration components in the 
CMM axis system (Ax, Ay and Az), the probe head displacement vector (Dph) is thea 
deduced from Ax, Ay and Az. The positional relationship between the probe tip and 
probe centre is no longer the same, due to rotation about the orthogonal axes. The 

2 0 probe tip is displaced by Dt x, Dt_y and Dt_z with respect to the centre of the probe 
head. The instantaneous displacement of the probe tip from its nominal position 
(Dt_x, Dt_y, Dt_z) is calculated from the measured angular rotation and the known 
distance between the probe tip and the origin of the accelerometer axes. The 
estimated position of the probe tip in CMM coordinates is calculated from combining 

2 5 signals from the linear scales, probe head displacement (Dx, Dy, Dz) infomiation, and 

probe tip displacement (Dt_x, Dt_y, Dt_z) information. 

Rotational displacement at the probe head can also be determined without the use of 
angular acceleration sensing. Such a method involves calculating angular acceleration 

3 0 using translational acceleration information, for example, rotational acceleration about 
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the X-axis (Rx) is deduced by calculating the arctangent of Aph_z over Aph_3^. 
Rotational displacement is obtained by integrating twice over time. This is a less 
accurate method, and can be used in systems where rotations without translations are 
not expected. 

5 

Correctin^z Rotational Distortion due to a Motorised Servo Positionini^ Head 
Measurement errors can also be introduced by rotational torques generated by a 
motorised probe head. One example is the reaction torque generated by a motorised 
servo positioning probe head which is itself in motion and taking measurements at the 

1 0 same instance. In such a situation, the probe head can be dynamically distorted from 
its nominal position due to the torsional bending of the CMM since torque generated 
by a motorised head is taken back-to-earth through the CMM structure. The process 
described under the heading "Correcting Translational and Rotational Errors" will 
measure the amount of angular displacement at the probe head and so correct the 

15 measurem^ts obtained from a motorised probe head's rotary encoder system. 

Accelerometers Configuration 

Currently available accelerometars measure acceleration in eith^ one, two or three 
axes. There are many diffeent permutations for placing these sensors depending on 

2 0 their type and measurement axis. The simplest method of measuring acceleration on 
the probe head in three orthogonal axes is with a 3 -axis accelerometer (or 3 single axis 
accelerometers), shown in Figure 2a. Rotation about each of the three orthogonal axes 
can either be measured using gyroscopes or additional accelerometers. Figure 2b 
shows a configuration using 3 gyroscopes and a 3-axis accelerometer- Configurations 

2 5 usiag single, dual and three axes accelerometers to measure both translation and 

rotation are shown in Figures 2c, 2d, & 2e, six degrees of movement (3 translation and 
3 rotation) is derived by combining the measurements from different sensors. 
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Equations for a six single axis accelerometers configuration (Figure 2c) are: 

Azl - Az2 AyX + Jiy2 



Ay = fiy = 

^ 2 y 2 r 



AyX ' Ay2 Axl + Ax2 

A. 

10 



Equations for a four dual axis accelerometers configuration (Figure 2d) are: 



_ A3x - A4jJ .5 „ A3g A4z 

■< 2 2^ 
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a - A^z •*- A2Z ~ Axz Aiy + A2y 
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Equations for a four 3-axis accelerometers configuration (Figure 2e) are: 



Rx 



A3s + 
2r 



_ Aiy - A2y + Asy - A4y 



Aiz A2z 
2 r 



As 



A3s 



A4Z + A2z ~ Aiz 
4 



Aiy + A2y " A^x ~ 
4 r 
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where 



r denotes the distance of the accelerometer from the axis of 

rotation 

Rx, Ry, Rz denotes angular rotation about the x,y & z axis respectively 
Ax, Ay, Az denotes acceleration in the x,y & z axis respectively 



Calibrating the Accelerometers 

Accelerometer measurements need to be corrected for error in scaling, paralleUsm 
15 between the CMM and accelerometer measurement axis, and transverse sensitivity 
errors generated within a multi-axis accelerometer unit. A method proposed for 
calibrating the accelerometer data is by moving one CMM axis at a tune with a pre- 
determined low frequency sinusoidal position demand, where the scales and probe 
head are rigidly coupled. An ideal 3-axis accelerometer on a perfectly orthogonal 
2 0 CMM will only sense movement in one axis, however in practice, it is likely that the 
sensor will sense movement in all 3 axes due to reasons stated above. Acceleration 
measurements of the probe head in 3 axes and scale measurements are stored, and 



wo 02/04883 



PCT/GBOl/03026 



7 

then post-processed to determine the magnitude and phase of the displacement at the 
probe head due to a known position demand in a particular CMM axis. 



The steps required for processing the stored accelerometer measurement data consists 
5 of first, integrating twice over time to derive probe head displacement. The result will 
be a sinusoidal displacement for each probe head axis, the magnitude and phase of the 
sinusoidal displacement of each probe head axis can be calculated using a number of 
techniques (e.g. a Fast Fourier Transform algorithm). The magnitude of the probe 
head displacement then needs to be normalised so as to produce data with the same 
10 scaling (measurement units) as the CMM scales. The phase of the displacement at the 
probe head is used to determine the polarity of the scaling factor (e.g. a 180° phase 
shift would incur a negative scaling factor). Using this method a calibration matrix 
for scaling displacement derived from the accelerometers is obtained. 

15 A 3-by-3 matrix (A) is first obtained by deriving the normalised displacement 

magnitude and phase shift in all 3 axes of the probe head when moving each CMM 
axis individually. 



Axx Axy Axz 

Ayx Ayy Ayz 

Azx Azy Asz 



where 

0 

Axx denotes the measured normalised displacement of the probe head in the X-axis 

due to a CMM X-axis position demand 
Axy denotes the measured normalised displacement of the probe head in the Y-axis 

due to a CMM X-axis position demand 
5 Axz denotes the measured normalised displacement of the probe head in the Z-axis 

due to a CMM X-axis position demand 
Ayx denotes the measured normalised displacement of the probe head in the X-axis 
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due to a CMM Y-axis position demand 
Ayy denotes the measured normalised displacement of the probe head in the Y-axis 

due to a CMM Y-axis position demand 
Ayz denotes the measured normalised displacement of the probe head in the Z-axis 
5 due to a CMM Y-axis position demand 

Azx denotes the measured normalised displacement of the probe head in the X-axis 

due to a CMM Z-axis position demand 
Azy denotes the measured normaUsed displacement of the probe head in the Y-axis 

due to a CMM Z-axis position demand 
1 0 Azz denotes the measured normalised displacement of the probe head in the Z-axis 

due to a CMM Z-axis position demand 

The accelerometer displacement scaling matrix (S) that converts measured 
displacement from the accelerometer to actual displacement is obtained by inversing 
15 matrix A. 



The sensors used to detect angular acceleration need to be calibrated before the probe 
head is mounted onto a CMM. One method of calibrating the accelerometer 
configurations shown in Figures 2c, 2d & 2e is by rotating the probe head with a 

2 0 constant sinusoidal angular acceleration and measuring the angular accel^tion about 
that axis. The measured angular acceleration is then compared with measurements 
taken simultaneously with a primary angular acceleration sensor to determine the 
scaling factor required for converting measurements obtained from the accelerometers 
in the probe head into angular acceleration units. A similar method can also be used 

25 to calibrate the probe head translational sensing accelerometers. 
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Data Fusion Algorithm Usins Complementar\> Filters 

Block diagrams showing this data fusion algorithm are presented in Figures 3a & 3b, 
the algorithm assumes that at low frequencies the measurement scales and the probe 
head are rigidly coupled together. However, at and above the natural frequency (fri) 
5 this is no longer true, the probe head and measurement scales starts to became 
decoupled. 

The data fusion algorithm shown in Figure 3b for illustration purposes is only for the 
X-axis. The process is similar for the other 2 axes. The algorithm combines 

10 displacement data from the scales with displacement data obtained from acceleration 
sensors in the probe head with a pair of complementary filters. The signals (Ax, Ay, 
Az) from the probe head accelerometers are first integrated twice over time via a 
bandlimited double integrator to obtain displacement, the displacement signal then 
needs to be normalised and resolved to have the same scaling and direction (x-axis) as 

15 the readhead measurement via a scaling matrix. Since signals produced from certain 
accelerometers are normally prone to offset drift caused by change in temperature and 
other external factors, the integrator is frequency bandwidth limited to remove low 
frequencies and offset signals. The derived x-axis displacement information of the 
probe head (30) is then filtered with a high pass filter (this filter is the complement of 

2 0 the low pass filter) and then added to the low pass filtered information from the scales 
(31). The result (Fx) is an estimate of the position of the probe head due to the 
presence of stmctural vibrations that is undetectable by the measurement scales. 

Data Fusion Algorithm Usin2 Two Accelerometers Per Axis in Differential Mode 

2 5 Figures 4a & 4b present block diagrams showing a method using 2 accelerometers on 

each CMM axis to determine the displacement of the probe head from its nominal 
centre. The extra acceleromet^r should ideally be mounted within or near the 
readhead for the linear scale, however, anywhere else that is rigidly coupled to the 
axis readhead will sufiSce. This accelerometer needs only to measure acceleration in 

3 0 the axis of the linear scale, thus 3 single axis accelerometers (one in each readhead) 

will suffice. 
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The data fusion algorithm shown in Figure 4b for illustration purposes is only for the 
X-axis. The process is similar for the other 2 axes. The signal from the x-axis 
readhead accelerometer (ASx) is first integrated twice over time via a bandlimited 
double integrator to obtain displacement, the displacement signal then needs to be 
5 normalised to have the same scaling as the readhead measurements via a scaling 

factor. This process produces a signal (40) representing high frequency displacement 
information at the x-axis readhead. The signals (Ax, Ay, Az) from flie probe head 
accelerometers are processed in a similar maimer to obtain x-axis probe head 
displacement information (42), X-axis probe head displacement (42) is then added to 
1 0 the inverted x-axis readhead displacement (41), this process produces a signal (43) 

representrug the displacement of the probe head in the x-axis that is not detectable by 
the readheads. This signal (43) is then added to the x-axis linear scale measurement 
(Sx) to obtain the instantaneous x-axis coordinate of the probe head (Px). 

15 Data Fusion Algorithm for Rotational and Translational Displacement of a Probe 
Head 

Figures 5a & 5b shows a strategy using acceleration sensors to measure displacement 
of the probe head from its nominal centre in 3 translation and 3 rotational axes. The 
data fusion algorithm uses this information together with position and acceleration 
2 0 information from the linear scales to determine the position of the probe head and 
probe tip. Angular rotation information is first used to determine a 3-by-3 direction 
matrix [C], the direction matrix is then used to transform the translational acceleration 
information at the probe head (Aph_x, Aph_y, Aph_z) into the CMM axis system 
(Ax, Ay, Az). The acceleration components in the CMM axis system is double 

2 5 integrated and scaled, and then added to the respective acceleration at flie readheads. 

The result is the translational displacement of the probe head from its nominal centre 
(Dx, Dy, Dz). This information is then added to the position information from the 
linear scales to give the absolute position of the probe head. 

3 0 The displacement of the probe tip from its nominal position is determined by double 

integrating and scaling the angular acceleration information, this would provide 



wo 02/04883 



PCT/GBOl/03026 



11 

rotational displacement information of the probe head. Knowing the physical 
dimensions of the probe head, i.e. the distance between the probe tip and centre of 
accelerometer axis, and the orientation of the probe stylus. The displacement of the 
probe tip from its nominal centre can be calculated. Finally, the measurement point is 
5 obtained by adding displacement of the probe tip from its nominal centre to the 
absolute position of the probe head. 

Data Fusion Algorithm for Rotational Displacement of a Motorised Servo Positionins 
Probe Head 

10 Figures 6a & 6b shows a method for correcting measurements due to probe head 

displacement and rotation from its nominal centre. This strategy is specific to catering 
for torque generated by a servo positioning motorised probe head that is taking 
measurements when the probe head is under motion control. This strategy is similar 
to that described in Section 5.6 except that the orientation of the probe tip can be 

1 5 continuously changing and needs to be taken into consideration when calculating the 
true position of the probe tip. Position information from the rotary encoder needs to 
be corrected for any rotation displacement at the probe head generated by the 
motoring torques. This is achieved by using rotational displacement infomiation 
obtained from the angular accelerometers and using this information to correct the 

2 0 position information from the rotary encoders. This data fusion algorithm provides 

the instantaneous absolute position of the motorised probe head (Px, Py & Pz), 
together with the corrected angular position of the probe stylus from the rotary 
encoders (De and Dd). The relative position of the probe tip to the centre of the probe 
head is calculated from the rotary encoder information (De & Dd). The true position 
25 of the probe tip is then calculated by adding the relative position of the probe tip to the 
absolute position of the probe head (Px, Py, Pz). 

BacksTOund Infonnation on Accelerometers 

The accelerometers may be operated in either open or closed loop configurations. The 

3 0 closed loop configuration uses force feedback re-balancing of the proof mass to 

improve the quality of the acceleration signal. This configuration is normally used in 
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highly acciirate inertial navigation systems that requires high sensitivity and at the 
same time cannot tolerate errors in offset bias (drift) and linearity. However, these 
accelerometers are expensive. 

5 Open loop configuration accelerometers have the undesirable characteristics of being 
sensitive to supply voltage variation, non-linearity of the output, and high thermal 
coefQcients of bias and scale factor. These undesirable characteristics can be 
minimised to an extent with the use of additional electronic circuits. However, the 
performance will not approach that of a closed loop accelerometer. The main 
1 0 advantage of open loop accelerometers is their low cost. 



